#include <card/tlc5940/servo.h>

#include "Tlc5940.h"
#include "tlc_servos.h"


namespace card {
namespace tlc9540 {


extern bool tlc9540_used;


servo::servo(uint8_t init_pos)
{
  if (!tlc9540_used)
  {
    tlc9540_used = true;
    _valid = true;
    tlc_initServos(init_pos);
  }
  else _valid = false;
}


bool servo::set_position(int servo_id, uint8_t pos)
{
  tlc_setServo(servo_id, pos);
  return Tlc.update();
}


} // tlc9540
} // card
